function H=computeH(theta, Q, R)
H = theta' * Q * theta + R;
end